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OPTIMAL  TRIANGULATION 
IN  THE  PRESENCE  OF  RANGE 
ERRORS 


A.  A.  GOLDSTEIN 
I.  BERT  RUSSAK 


ABSTRACT 

The  problem  of  determining  the  location  of  a  fixed  point  using  range  only 
data  occurs  in  a  variety  of  areas  including  military  applications.  An  example 
is  outlined  below  and  formed  the  incentive  for  the  work  herein.  The  application 
consisted  of  precisely  locating  hydrophones  placed  on  a  ship's  hull  for  the 
purpose  of  receiving  acoustic  signals  to  be  used  in  calculating  torpedo  positions 
during  a  test.   In  this  paper  a  method  is  developed  which  under  the  assumption 
of  fixed  system  error  input  (in  range  data)  produces  the  smallest  possible 
error  in  locating  the  hydrophones. 

ANALYSIS 

Our  goal  is  to  determine  the  coordinates  of  a  point  in  3-dimensional 
space.   For  the  purpose  of  simplicity  we  first  investigate  the  2-dimensional 
version  of  this  problem  and  then  extend  it  to  the  3-dimensional  case. 

The  determination  of  the  coordinates  of  a  point  in  the  plane,  requires 
a  minimum  of  two  observations.  We  investigate  the  geometry  of  that  situation. 
Let  positions  1  and  2  be  the  known  observer  positions  with  d  the  distance 
between  them  while  p  is  the  hydrophone  position  which  is  to  be  determined. 
We  assume  a  coordinate  system  with  1  at  the  origin  and  with  x-axis  defined  by 
1  and  2.  The  associated  figure  is  below  in  which  rj  and  r2  are  the  re- 
spective ranges  from  observers  1  and  2  to  p  and  9,  a  are   the  indicated 
angles. 


Figure  1 
Two  Dimensional  Nominal  Triangularization 

The  figure  is  redrawn  below  with  indicated  errors   Arls  Ar2,  A6  respec- 
tively in  the  ranges  r:,   r2   and  in  the  angle  e  .  An  associated  new 
location  point  P'       determined  from  the  ranges  with  errors  is  also  drawn. 


1  2 

Figure  2 
Two  Dimensional  Triangularization  with  Errors  in  the  Ranges 


The  vector  difference  between  positions  P  and  ?'      is  indicated  by  LP 

and  is  seen  to  be  made  up  of  two  components,  namely  the  component  Arj  along 

rx  and  the  component  rjA6  perpendicular  to  Pj.  Thus  with  lfj  and   le 

as  unit  vectors  along  rx  and  perpendicular  to  it  respectively,  we  have  the 
vector  equation : 

1  )   AP  =  r1A(3le  +  ArjlPj 

Next,  according  to  the  law  of  cosines,  we  obtain  2a)  and  2b)  while  2c)  is 
justified  by  the  law  of  sines. 


2a)  co6  a  =  r12   +  r?::  -  d: 
2rxr2 


2b)  co*   9  =  rY2   +   d2  -  r22 
2rxd 


2c)  r2  _  bjji 
cT 


■6-cn  a 


Forming  the  total  differential  of  2b),  simplifying  and  solving  for  A6  gives 


3)    A6  =  -  1 


rid  &AM 


ri2   +   r22  -  d2  Arx  -  r2Ar2 
2r2 


lext,  by  using  2a)  we  get 


4)        A6  =  -   r< 


r^  hui  0 
and   by  2c)   after  simplifying 


coi>   a  APi   -   Ar2 


A9 


1 


rj    6^n  a 


co-6   a   Arj    -    Ar2 


so   that  after  multiplying  by     rl 


6)  rjA9  =  Ar2  -  Ari  CQA   a. 

6-Ul  a 

Using  absolute  values  to  consider  the  worst  case  situations,  i.e.  where  the 
contributions  to  rjAB  from  Ari  and  Ar2  add  up,  we  get 

7)  \r1AQ\   4  | Ari  C06   a\    +  |Ar2| 

6  in  a 

It  is  clear  that  7)  that  for  given  errors  Arj,  Ar2   then  the  minimum  of  the 
worst  case  situation  for  rjAO  and  hence  for   |aP*|   occurs  when  a  =  n/2,  i.e, 
when  the  lines  of  sight  from  1  and  2  to  P  are  perpendicular. 

Extension  to  the  3-Dimensional  Case 

The  previous  analysis  suggests  the  following  rule  for  obtaining  the 
minimum  error  in  locating  the  point  P  in  3-dimensional  space.   For  a  given 
set  of  range  errors  from  the  observers,  then  in  the  worst  case,  the  resulting 
vector  error  in  locating  the  point  P  will  be  smallest  in  magnitude  if  the 
respective  lines  of  sight  from  the  observers  are  mutually  perpendicular. 

This  conclusion  is  also  born  out  by  the  following  alternate  analysis: 

Let  x,y,z  be  the  unknown  coordinates  of  the  point  P  and  x  ,  ,  y  , ,  z  . 
the  coordinates  of  the  k —  observer  and  r,   the  range  from  the  k —  observer 
to  P.  Consider  the  system  of  equations 

8)  /(x-x^)2  +  (y-ysk)2   +  (z"zsk)2  ■  rk  k  =  i,2  ,3 

The  procedure  used  to  solve  8)  is  detailed  later  but  is  based  on  forming 
an  approximate  solution  xn,  yn,  z^  to  8)  and  making  a  correction  6x,  5y,  6z 
to  xn,  yn,  z^.  That  correction  is  the  solution  of  the  linear  equations 


9)   (xn-x  .)5x  +  (yn-y  .  )fiy  +  (zn-z  ,)sz    =  &r.        k  =  1,2,3 


'0  sk 


0  'sk 


0  sk 


k,0 


where:  r^  =^Tvxsk)2  +  (y0"ysk)2  +  (z0"Zsk 


and   ork  =  (rk-rR  0)  i.e 


the  residual  in  solving  8)  by  the  approximate  solution 


Writing  M  as  the  matrix 


10) 


x«-  x  , 

0   si 


M  = 


1,0 


xn  -  x 

0     S2 


2,0 


Xn  -  X 

0     S3 


3,0 


y0  -  ysi 
ri.O 


y0  -  ys2 


2,0 


y0  "  ys3 


3,0 


Z0  -  2si 

ri.o 


zn  -  z 
0     S2 


2,0 


Z0  -  ZS3 


3,0 


then  9)  is  the  system  of  linear  equations 


11) 


Sx" 

firj 

5y 

= 

5r2 

<5Z 

fir3 

. 

L         J 

If  r.   is  in  error  by  Ar,   then  also   fir.   is  in  error  by  A(fir.  )  =  Ar. 
Define  the  vectors 

12a)  A(6r)  =  (A(or!),  A(fir2),  A(5r3)) 
12b)   Ap   (A(5x),  A(6y),  A(fiz)) 

so  that  in  the  Euclidean  norm 


12c)    ||A(tr)||    =v/[A(5r1)]2  +  [A(fir2)]2   +   [A(fir3)]2 


12d)    Ma^II    =  ytACfix)]2   +   [A(5y)]2   +   [A(6z)]2 


Then  referring  to  11),  it  is  well  known  that  for  a  given  set  of  A(5r,  ) 
k  =  1,2,3,  then   \&P\  will  be  smaller,  the  closer  is  the  condition  number 

of  M  to  one  (see  [1]).  By  examining  the  rows  of  M,  one  sees  that  these  rows 
are  (except  for  errors  in  the  matrix  terms),  unit  vectors  along  the  lines  of 
sight  from  observers  to  P.  Thus  if  these  lines  of  sight  are  made  mutually 
perpendicular  then  the  matrix  M  will  be  an  orthogonal  matrix  and  11)  then 
represents  an  orthogonal  transformation  between  (ap)  and  A(6r).  For  such 
a  transformation  the  condition  number  is  equal  to  one. 

Thus  for  the  triangulation  problem  in  3-dimensional  space,  a  given  set 
of   Arls  Ar2,  Ar3,  will  produce  the  smallest    [aP|   when  the  lines  of 
sight  from  the  observers  form  a  mutually  orthogonal  set  of  vectors. 

Such  a  situation  is  accomplished  in  the  following  figure  in  which  the 
three  observers  are  in  the   x-y  plane  and  point  P  is  below  the  x-y  plane. 


Figure  3 
Optimal  Observer  -  Phone  Geometry 


Method  of  Solution 

The  method  of  solution  used  is  linearized  least  squares  and  is  now 
described. 

Let  x    y    z    be  an  initial  estimate  (the  method  of  determining 
this  will  be  described)  of  phone  position. 

We  seek  to  determine  hydrophone  coordinates  x,y,z  such  that  the  following 
equations  are  satisfied 


13)   v/(x-xsk)2  +  (y-ysk)2+  (z-zsk)2  =  rk    k=1,...,m 

where  m   is   the  number  of  observations  and   r\    is   the  observed   range   from  the 

!  th      ^ 

k —  observer. 


Let  x{      ,  y   ,  z*1'  be  the  estimates  of 


phone  coordinates  after  i 


iterations  and  let  r|<  '    be  the  associated  range  (computed  from  x        ,   y^'.z^1 
to  observer  k.  Thus 


.(1) 


+  fv(1)-vc)2  +  fz(i)-; 


14)  a  (xwy-xsk)2  +  (yv"-ysk)2  +  (z^-zsk)2  =  rk 


(i) 


k=l , . . .  ,m 


The  correction   5x,   &y,    6z   to  x'      ,   y       ,   z^    is  computed  as   the  least 


squares   solution  of  the  system. 

15)  (x(l)-xsk)5x   +     (y(n)-ysk)6y  +   (z(l)-zsk)6z     =  rk-rk        k=l,...,m 


(i) 


The  (i+l)st  estimate  of  phone  position  is  then 

y 


16)   x<i+1>  ^x'1'  +  6x    y<i+1>  -y'1''  ♦  Sy       z<1+1>  =z(i>  ♦  Sz 


and  then  equations  15)  and  16)  are  re-solved  with  i+1  replacing  i.   Convergence 

of  the  process  is  accepted  when  the  change  in  phone  position  is  less  than  10~' 
on  successive  estimates. 

Initial  Solution  Point  for  Least  Squares  Technique 


An  initial  solution  point  is  necessary  in  order  to  use  the  linearized 
least  squares  iterative  technique  described  previously.  The  equations  for 
determining  that  initial  point  now  follow: 


The  figure  which  indicates  the  3-dimensional  triangularization  is  shown 
below  with  the  observers  indicated  by  1 ,  2,  3,  and  the  unknown  phone  by  P.  The 
x-y  plane  will  generally  coincide  with  the  surface  of  the  water.  For  ease  of 
illustration,  P  has  been  drawn  above  the  x-y  plane  when  in  reality  it  will  be 
below  that  plane.  However,  this  distinction  will  be  taken  care  of  by  the 
mathematics  to  follow.   In  addition:  a)  for  purpose  of  simplifying  the  mathe- 
matics, the  y  axis  will  be  defined  as  passing  through  observers  1  and  2  with 
the  origin  at  observer  1  and;  b)  the  angles  u,  i  are  as  indicated  with  i  re- 
presenting the  inclination  of  the  plane  containing  1,  2  and  P  to  the  x-y 
plane.  Z 


Figure  4 
Geometry  for  Initial  Estimate 


Writing  the  coordinates  of  P  we  have: 

17)  P  =ri  6  in  u.  co6  i       P  =ri  co6   u.    P  =n  hivi   u  -iin  i 
'        x  L  y  l  z  i 

and  with  C  ,  C  ,  C   as  the  coordinates  of  observer  3  then 

18)  r32  =  (n  6in   u  cot  I  -   C  )2  +  (n  cos  a   -  C  )2  +  (n  &in  u.  hln  I 

x  y 


cz> 


After  squarring  terms  out,  and  letting  S3  represent  the  distance  of  observer 
3  from  the  origin  so  that 

19)  S32  =  Cx2  +  Cy2  +  Cz2 
we  get 

20)  r32  =  ri2   +  S32  -  2r/cy  co6   a 

-2ti   icn  u.  v/cx2  +  C22 


C  C06  -i 
x 

Cx2  +  Cz2 


+   C  A^cn  -c 


\/C?  +  C- 


Defining  the  quantities 


21  )     coi   t  =  C, 


/c/Tcz2 


Ain  t  =  -C 


y  c  2  +  c  2 


and  using  a  trigonometric  identity,  we  solve  for  the  angle  t+x  from  20) 


22)  co6  (c+t)  =  -r32  +  rT2  +  S32  -  2r1Cy  co6   a 


2r~i  6am  u  \/Cx2  +  Czz 


We  now  recognize  that  x  is  a  small  angle  (assuming  C^O)  since  it  mea- 
sures how  far  observer  3  is  out  of  the  x-y  plane  and  all  observers  will 
nominally  be  positioned  in  the  x-y  plane.  Thus  the  quadrant  of  c+x  is  the 
same  as  the  quadrant  of  -i.      Determining  I     from  21),  22)  and  the  remark 
following  22)  and  multiplying  by  minus  1  which  is  consistent  with  P  below 
the  x-y  plane,  -  we  complete  the  determination  of  I.      Then  use  17)  to  solve 
for  the  coordinates  of  P. 


Numerical  Results 

In  order  to  illustrate  the  effect  of  the  geometry  on  the  resultant 
accuracy  in  determining  the  phone  position,  a  number  of  computer  runs  were 


made  with  noise  added  on  to  the  exact  ranges.  The  nominal  range  was  100  feet 
and  the  noise  was  generated  from  a  uniform  random  number  generator  with  mean  of 
zero  and  maximum  noise  magnitude  of  .1  ft  (which  is  representative  of  the  equip- 
ment being  used).  Using  the  ranges,  from  the  three  sightings,  each  run  had 
different  angles  between  their  respective  lines  of  sight  to  the  phone. 

We  give  the  results  as  errors  Ax,  Ay,  az  in  determining  the  various 
components  x,y,z  of  hydrophone  position.  In  addition  we  also  list  the  square 
root  of  the  sum  of  the  squares  of  the  component  errors  and  call  this   |ap||. 
Finally,  each  run  is  actually  the  result  of  four  sub-runs  each  with  a  different 
noise  sample.  The  results  listed  are  for  the  sub-run  with  the  largest  value 

of  ||a?||. 


Table  1 


Range  =  10C 

)   Feet 

Angle   between 
Lines  of  Sight 

Ax (feet) 

Ay (feet) 

Az(feet) 

IU?II 

(fe 

=  ^AX2   +  Ay2  +  AZ2 

15° 

.21 

.33 

.03 

.40 

30° 

.11 

.17 

.03 

.20 

45° 

.07 

.11 

.03 

.14 

60° 

.06 

.09 

.03 

.11 

90° 

.04 

.06 

.04 

.09 

110° 

.03 

.05 

.08 

.11 

The  above  table  bears  out  the  theoretical  result  obtained  previously  - 
namely  that  the  errors  in  locating  the  hydrophone  are  minimized  when  the 
lines  of  sight  from  the  observers  to  the  hydrophone  are  mutually  perpendicular, 

The  method  considered  here  is  invariant  to  range  changes  and  this  is 
shown  by  running  a  case  with  the  ranges  at  1,000  feet. 
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Table  2 


Range   =  1000  feet 


Angle  between 

Ax(feet) 

Ay (feet) 

Az(feet) 

Lines  of  Sight 

II  AfJ  II  =  vAx2  +Ay2  +Az;:    (feet 

90° 

.04 

.06 

.04 

.09 

11 
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